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(54) Method and processor lor obtaining moments and torques in a biped walking system 



(57) A method and processor (1 6) for obtaining tor- 
ques to be applied to joints (8,10,12) of a leg (2) of a 
biped walking system (1) are provided. The method 
comprises the steps of obtaining moments (M^ ,M2) act- 
ing around the joints (8,10,12) of the leg (2), using the 
vertical component (F^) of the ground reaction force (F) 
acting on the leg (2) at the point of application of the 
ground reaction force (F), the vertical components (F^^, 
^2z'^3zi of forces acting on the joints (8,1 0,12) of the leg 
(2) and a term of the acceleration of gravity and without 
using the horizontal components (fw^2x'^3x) ^^e 



forces acting on the joints (8,10,12) of the leg (2) and a 
term of acceleration except the term of the acceleration 
of gravity and obtaining the torques to be applied to the 
joints of the leg, based on the moments acting around 
the joints (8,10,12) of the leg (2). 

The vertical component (F^) of the ground reaction 
force (F) acting on the leg, is obtained based on which 
leg or legs (2) are in contact with the ground, the attitude 
of the leg (2) and the vertical component of acceleration 
of the center of gravity of the whole body including the 
leg (2). The processor is configured to perform the 
above steps. 
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Description 

FIELD OF THE iNVENTION 

5 [0001] The present invention relates to a method for obtaining nnoments acting on joints of legs of biped walking 
system such as biped walking robots. The present Invention further relates to a method for obtaining torques to be 

given to joints of legs. 

BACKGOUND OF THE INVENTION 

10 

[0002] It is required to obtain ground reaction forces acting on legs of a biped walking system and then based on 
the ground reaction forces to obtain moments acting on joints of the legs of the biped walking system, in control of 
human assist systems and in control, of movement of biped walking robots. Such human assist systems are intended 
to assist human operations against gravity Including going up and down stairs, sitting and standing up, squatting, and 
15 moving up and down with heavy load. Based on data Including the obtained moments, assist torques for human assist 
systems or a target driving torque for each joint of biped walking robots can be determined. 

[0003] Japanese Patent Application Unexamined Publication (KOKAI) No. 2000-249570 discloses a method for ob- 
taining ground reaction forces. In this technique, ground reaction forces acting on legs are obtained as a linear com- 
bination of trigonometric functions having different periods of 1/ n (n=1 , 2,...) of a walking period, because wavefomns 
20 representing temporal changes in ground reaction forces acting on legs, periodically change while a biped walking 

system is normally walking. In this case, as weighting factors of respective trigonometric functions for the combination, 
fixed values predetermined for each biped walking system or those obtained by adjusting the fixed values according 
to geographic features, are employed. 

[0004] However, in the above technique, ground reaction forces acting on legs are obtained for a step or steps of 
25 biped walking systems and therefore accurate ground reaction forces can hardly be obtained In such a case as walking 
manner of biped walking systems successively changes. Further, for higher accuracy of ground reaction forces to be 
obtained, weighting factors of trigonometric functions must be set for each biped walking system and must be adjusted 
according geographic features. So, it Is very difficult to obtain accurate ground reaction forces without being affected 
by environment where biped walking systems move and by Individual variation of biped walking systems. 
30 [0005] U.S. patent No. 6,152,890 discloses an apparatus and a method to measure load of working persons. How- 
ever, the apparatus and method do not enable accurate measurement of torques acting on the joints. 
[0006] As to biped waking robots, for example, a method is known, in which sensors such as 6-axis force sensors 
are set to ankles or feet of the robots to obtain ground reaction forces. Further, another method Is known in which biped 
walking systems are made to walk on a force plate on the floor to obtain ground reaction forces based on outputs of 
35 the force plate. 

[0007] However, in techniques using force sensors, it is necessary to attach force sensors to ankles and feet of a 
person in order to obtain ground reaction forces acting on the legs of the person. Such force sensors hinder the person 
from walking In his or her dally life. Further, In techniques using a force plate, ground reaction forces can be obtained 
only under an environment In which the force plate has been installed. 

40 [0008] In conventional human assist systems, differential operations are used to obtain moments on joints of legs 
and the differential operations cause noises of moments on joints of legs. Additionally, horizontal components offerees 
are used to obtain moments on joints of legs. Since horizontal forces, or accelerations are hard to measure, measured 
horizontal forces cause errors In moments on joints of legs. Further, many acceleration terms must be obtained. Ac- 
cordingly, huge amount of differential operations might restrict real-time processing. 

45 [0009] Under the situation mentioned above, there is a great need for a simpler joint moment estimation method by 
which moments acting on joints of legs can be obtained accurately and in real time, particularly for persons as biped 
walking systems. 

[0010] Additionally, there Is a great need for a real-time and robust control method of biped walking systems by which 
torques such as assist torques applied to joints of legs in human assist systems or the like, can be obtained. 

50 

SUMMARY OF THE INVENTION 

[0011] First, the basic idea of an estimation method of ground reaction forces, used In joint moment estimation method 
for biped walking systems of the present invention, will be described below. 
55 [0012] Motions of biped walking systems, for example, motions of legs in walking, include a single-support phase in 
which one of the legs (2, 2) of a biped walking system is in contact with the ground as shown in Fig. 1 (a) and a double- 
support phase in which both of the legs (2, 2) are in contact with the ground as shown in Fig. 1 (b). 
[0013] In a single-support phase, the equation of (translatlonal) motion of the center of gravity of the biped walking 
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system in the absolute coordinate system fixed to tine ground on whicli tlie biped walking system moves, represents 
such a relationship as below. That is, the relationship is that a product of an acceleration of the center of gravity and 
a weight (mass) of the biped walking system equals the resultant of gravity (a product of the weight of the biped walking 
system and the acceleration of gravity) and the ground reaction force acting on the leg in contact with the ground. 
[0014] More specifically, if component in the X direction (the horizontal direction in which the biped walking system 
(1) moves) and that in the Z direction (the vertical direction) of acceleration a of the center of gravity GO of the biped 
walking system, are represented as ax and az and component in the X direction and that in the Z direction of the ground 
reaction force F are represented as Fx and Fz, as shown in Fig. 1 (a), the equation of motion of the center of gravity 
GO is represented as below. 

"^(Fx ,Fz ul M« g) = M» (ax ,az) (1) 
where M is a weight of the biped walking system and g is the acceleration of gravity 

[0015] In both sides of Equation (1), "■"( , ) represents a two-component vector. Hereinafter, a notation in the form of 

( , ) represents a vector 

[001 6] Accordingly, if the vertical component of acceleration az at the center of gravity GO of the biped walking system 
(1), is obtained, the vertical component of the ground reaction force can be obtained by substituting the vertical com- 
ponent of acceleration az, a value of weight IVI of the biped walking system (1) and that of the acceleration of gravity, 
into Equation (2) shown below. 

.@.@.@Fz= M . (az+g) (2) 

[0017] Inthis case, the weight M required to obtain an estimatedvalue of the ground reaction force F can be previously 
obtained by measurement or the like. Further, a location of the center of gravity GO and the horizontal component of 
acceleration az can be obtained through a known technique, using outputs of sensors including those detecting bending 
angle (rotation angle) at respective joints of the biped walking system, accelerometers, gyroscopic sensors and the 
like, as described in detail below. 
50 [0018] In a double-support phase, the equation of (translational) motion of the center of gravity of the biped walking 
system, represents such a relationship as below. That is, the relationship is that a product of an acceleration of the 
center of gravity and a weight of the biped walking system equals the resultant of gravity (a product of the weight of 
the biped walking system and the acceleration of gravity) and two ground reaction forces acting on the both legs. The 
two ground reaction forces act respectively on the both legs at portions in contact with the floor. More specifically, if X 
and Z components of ground reaction force Ff acting on the leg (2) in the front in the direction of travel are represented 
as Ffx and Ffz and the X and Z components of ground reaction force Fr acting on the leg (2) in the rear are represented 
as Frx and Frz, the equation of motion of the center of gravity can be represented as below. 

40 "^(Ffx + Frx ,Ffz + Frz ul M» g) = M» (ax ,az) (3) 

where ax, az, M and g in Equation (3) are described above. 

[0019] According to the findings of the inventors, in a double-support phase, ground reaction forces Ff and Fr acting 
on the legs (2, 2) can be considered to substantially act at specific portions 12f and 12r near the lowest ends of the 
legs (for example, ankle portions) in directions toward the center of gravity of the biped walking system, as shown in 
Fig. 1 (b). The specific portions 12f and 12r and the ground reaction forces Ff and Fr acting on the legs (2, 2) can be 
related as below. That is, there exists a relationship that orientations of line segments connecting the center of gravity 
GO and the specific portions 12f and 12r of the legs (2, 2) are identical with orientations of the ground reaction forces 
Ff and Fr acting on the legs (2, 2). 

[0020] More specifically, if location coordinates of the center of gravity GO, those of the specific portion 1 2f of the leg 
in the front and those of the specific portion 12r of the leg in the rear are represented respectively as (Xg, Zg), (Xf, Xf) 
and (Xr, Zr), the above relationship can be represented as below. 

55 .@, @(Zf- Zg) / (Xf - Xg) = Ffz / Ffx 



45 
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.@. @(Zr-Zg)/(Xr-Xg) = Frz/Frx. @. @. @. @ 



(4) 



[0021] If Equations (3) and (4) are combined and a term of acceleration in tlie horizontal direction is regarded as 
5 being negligible small, the following equation can be obtained on the vertical components of ground reaction forces. 



where AZf = Xfiil Xg, AZf = Zful Zg, AXr = Xriii Xg and AZr = Zrul Zg . 

[0022] Accordingly, if the vertical component az of acceleration of the center of gravity of the biped walking system 
(1 ) and locations of the specific portions 1 2f and 1 2r of the legs (2, 2) with respect to the center of gravity of the biped 

20 walking system (1) are obtained, estimated values for the vertical components of the ground reaction forces Ffz and 
Frz of the legs can be obtained as below. The vertical component az of acceleration of the center of gravity of the biped 
walking system (1), locations of the specific portions 12f and 12r, a value of a weight M of the biped walking system 
(1 ) and a value of acceleration of gravity g, are substituted into Equation (5) to obtain estimated values of Ffz and Frz. 
[0023] In this case, the weight M required to obtain estimated values of the vertical components Ffz and Frz of the 

25 ground reaction forces can be previously obtained by measurement or the like. Further, the horizontal component of 
acceleration az, a location of the center of gravity GO and locations of the specific portions 12f and 12rwith respect to 
the center of gravity GO, can be obtained through a known technique, using outputs of sensors including those detecting 
bending angle (rotation angle) at respective joints of the biped walking system, accelerometers, gyroscopic sensors 
and the like, as described in detail below. 

30 [0024] If terms of accelerations except terms of the acceleration of gravity and terms of the horizontal components 
of forces are regarded as being negligible, the vertical components of forces and moments acting on the knee joints 
of the legs can be obtained as below. They are obtained based on the vertical components of the ground reaction 
forces obtained in such away as mentioned above, points of application of the ground reaction forces obtained based 
on attitude of the legs and the like and terms of the acceleration of gravity. The vertical components of forces and 

35 moments acting on the hip joint can be obtained based on the vertical components of forces and moments acting on 
the knee joints of the legs and the term of the acceleration of gravity Further, based on moments acting on the knee 
joints and the hip joint of the legs, torques such as assist torques to be applied to the knee joints and the hip Joint of 
the legs in human assist systems, can be obtained. Thus, control of human assist systems for assisting human oper- 
ations can be realized. 

40 [0025] Based on the above description, the present invention will be described below. A method for obtaining torques 
to be applied to joints of a leg of a biped walking system, according to the present invention comprises the steps of 
determining which leg or legs are in contact with the ground, obtaining an attitude of the leg and obtaining the vertical 
component of acceleration of the center of gravity of the whole body including the leg. The method further comprises 
the steps of obtaining the vertical component of a ground reaction force acting on the leg, based on which leg or legs 

45 are in contact with the ground, the attitude of the leg and the vertical component of acceleration of the center of gravity 
of the whole body including the leg and obtaining a point of application of the ground reaction force. The method further 
comprises the step of obtaining moments acting around the joints of the leg, using the vertical component of the ground 
reaction force acting on the leg at the point of application of the ground reaction force, the vertical components of forces 
acting on the joints of the leg and a term of the acceleration of gravity and without using the horizontal components of 

50 the forces acting on the joints of the leg and a temn of acceleration except the term of the acceleration of gravity. The 
method further comprises the step of obtaining the torques to be applied to the joints of the leg, based on the moments 
acting around the joints of the leg. 

[0026] Thus, in the present invention, the vertical components alone of forces acting on the legs are used and the 

horizontal components are not used. Accordingly, errors in measurement of forces in the horizontal direction, that is, 
55 accelerations in the horizontal direction do not cause errors in joint moments. Further, since the present invention does 
not need an acceleration of each portion of the leg except the acceleration of gravity, an operation speed is increased. 
Accordingly, real-time operations can be easily achieved in control of human assist systems for assisting human op- 
erations and the like. 
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Ffz = M • {iZf • (u| AXr • az u| AXr • g ) )u@ 
U@U@U@U@U@u@ytip^f • AZr u| AXr • AZf uj 
Frz = M • {^Zr • (AXf • az + AXf • g))u@ 
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[0027] According to an embodiment of the present invention, in the step of determining which leg or legs are in 
contact with the ground, the determination is made based on a value of the vertical component of acceleration measured 
on the body, Thus, complicated processes for the determination are not required and therefore an operation speed is 
further increased. Accordingly, real-time operations can be still easily achieved in control of human assist systems for 

5 assisting human operations and the like. 

[0028] According to another embodiment of the present invention, in the step of determining which leg or legs are 
in contact with the ground, the determination is made using a sensor. Thus, operations for the determination are not 
required and therefore real-time operations can be still easily achieved in control of human assist systems for assisting 
human operations and the like. Further, the determination is made with reliability based on the sensor. 

10 [0029] According to another embodiment of the present invention, in the step of obtaining a point of application of 
the ground reaction force, the point is obtained based on the attitude of the leg and a location of the center of gravity 
of the body. Accordingly, robust operations can be achieved with a simple method. 

[0030] According to another embodiment of the present invention, in the step of obtaining a point of application of 
the ground reaction force, the point is obtained further using information from a sensor. Accordingly, the point is obtained 

15 with reliability based on information form the sensor. 

[0031] According to another embodiment of the present invention, the vertical component of acceleration of the 
center of gravity of the whole body, is obtained based on locations of the centers of gravity of portions of the body, 
obtained based on attitudes of the leg and other portions of the body, and the vertical component of acceleration 
measured on the body. In particular, in going up and down stairs or going uphill or downhill, standing up or sitting down 

20 and bending and stretching with heavy load, the vertical component of acceleration is large enough to be measured 
with reliability. Accordingly, the vertical component of acceleration of the center of gravity of the whole body can be 
obtained with reliability. 

[0032] According to another embodiment of the present invention, in the step of obtaining moments acting around 
the joints of the leg, at first the vertical component of a force acting on and a moment acting around the knee joint of 

25 the shin, are obtained using the vertical component of the ground reaction force acting on the shin at the point of 
application of the ground reaction force and a term of the acceleration of gravity alone. Then the vertical component 
of a force acting on and a moment acting around the hip joint of the thigh, are obtained using the vertical component 
of a force acting on and a moment acting around the knee joint of the thigh and a term of the acceleration of gravity alone. 
[0033] Accordingly, a moment acting around the knee joint of the shin and a moment acting around the hip joint of 

30 the thigh can be obtained with reliability, using the ground reaction force acting on the leg at the point of application of 
the ground reaction force and a term of the acceleration of gravity alone. 

[0034] A method for obtaining moments acting around joints of a leg of a biped walking system, according to the 
present invention comprises the steps of determining which leg or legs are in contact with the ground, obtaining an 
attitude of the leg and obtaining the vertical component of acceleration of the center of gravity of the whole body 

35 including the leg. The method further comprises the steps of obtaining the vertical component of a ground reaction 
force acting on the leg, based on which leg or legs are in contact with the ground, the attitude of the leg and the vertical 
component of acceleration of the center of gravity of the whole body including the leg and obtaining a point of application 
of the ground reaction force. The method further comprises the step of obtaining moments acting around the joints of 
the leg, using the vertical component of the ground reaction force acting on the leg at the point of application of the 

40 ground reaction force, the vertical components of forces acting on the joints of the leg and a term of the acceleration 
of gravity and without using the horizontal components of the forces acting on the joints of the leg and a term of 
acceleration except the term of the acceleration of gravity. 

[0035] Thus, in the present invention, the vertical components alone of forces acting on the legs are used and the 

horizontal components are not used. Accordingly, errors in measurement of forces in the horizontal direction, that is, 
45 accelerations in the horizontal direction do not cause errors in joint moments. Further, since the present invention does 
not need an acceleration of each portion of the leg, an operation speed is increased. Accordingly, real-time operations 
can be easily achieved in obtaining moments acting around joints of the legs of the biped walking system. 
[0036] A processor for obtaining torques to be applied to joints of a leg of a biped walking system, according to the 
present invention, is operable in association with angular sensors on the joints and at least one accelerometer set on 
50 the body of the biped walking system. The processor is configured to perform the following steps. The steps include 
determining which leg or legs are in contact with the ground, using information from the at least one accelerometer 
and obtaining an attitude of the leg, using infonnation from the angular sensors. The steps further include obtaining a 
location of the center of gravity of the whole body including the leg and obtaining the vertical component of acceleration 
of the center of gravity of the whole body including the leg, using information from the at least one accelerometer. The 
55 steps further include obtaining the vertical component of a ground reaction force acting on the leg, based on which leg 
or legs are in contact with the ground, the attitude of the leg, the location of the center of gravity of the whole body and 
the vertical component of acceleration of the center of gravity of the whole body. The steps further include obtaining a 
point of application of the ground reaction force, using the attitude of the leg and the location of the center of gravity 
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of the whole body. The steps further include obtaining nnoments acting around the joints of the leg, using the vertical 
component of the ground reaction force acting on the leg at the point of application of the ground reaction force, the 
vertical components of forces acting on the joints of the leg and a term of the acceleration of gravity and without using 
the horizontal components of the forces acting on the joints of the leg and a term of acceleration except the term of 
5 the acceleration of gravity. The steps further include obtaining the torques to be applied to the joints of the leg, based 
on the moments acting around the joints of the leg. 

[0037] A processor for obtaining torques to be applied to joints of a leg of a biped wall<ing system, according to the 
present invention, is operable in association with angular sensors on the joints, at least one accelerometer set on the 
body of the biped wall<ing system and at least one sensor set on the leg. The processor is configured to perform the 

10 following steps. The steps include determining which leg or legs are in contact with the ground, using information from 
the at least one sensor set on the leg and obtaining an attitude of the leg, using information from the angular sensors. 
The steps further include obtaining a location of the center of gravity of the whole body including the leg, and obtaining 
the vertical component of acceleration of the center of gravity of the whole body including the leg, using information 
from the at least one accelerometer. The steps further include obtaining the vertical component of a ground reaction 

15 force acting on the leg, based on which leg or legs are in contact with the ground, the attitude of the leg, the location 
of the center of gravity of the whole body and the vertical component of acceleration of the center of gravity of the 
whole body. The steps further include obtaining a point of application of the ground reaction force, using the attitude 
of the leg and the location of the center of gravity of the whole body. The steps further include obtaining moments 
acting around the joints of the leg, using the vertical component of the ground reaction force acting on the leg at the 

20 point of application of the ground reaction force, the vertical components of forces acting on the joints of the leg and 
a term of the acceleration of gravity and without using the horizontal components of the forces acting on the joints of 
the leg and a term of acceleration except the term of the acceleration of gravity. The steps further include obtaining 
the torques to be applied to the joints of the leg, based on the moments acting around the joints of the leg. 
[0038] Thus, in the present invention, the vertical components alone of forces acting on the legs are used and the 

25 horizontal components are not used. Accordingly, errors in measurement of forces in the horizontal direction, that is, 
accelerations in the horizontal direction do not cause errors in joint moments. Further, since the present invention does 
not need an acceleration of each portion of the leg except the acceleration of gravity, an operation speed is increased. 
Accordingly, real-time operations can be easily achieved in control of human assist systems for assisting human op- 
erations and the like. 

30 [0039] Further, in the invention in which information from the at least one accelerometer is used to detemnine which 
leg or legs are in contact with the ground, complicated processes for the determination are not required and therefore 
an operation speed is further increased. Accordingly, real-time operations can be still easily achieved in control of 
human assist systems for assisting human operations and the like. 

[0040] In the invention in which information from the at least one sensor set on the leg is used to determine which 
35 leg or legs are in contact with the ground, operations for the determination are not required and therefore real-time 
operations can be still easily achieved in control of human assist systems for assisting human operations and the like. 
Further, the determination is made with reliability based on the sensor. 

[0041] A processor for moments acting around joints of a leg of a biped walking system, according to the present 
invention, is operable in association with angular sensors on the joints and at least one accelerometer set on the body 

40 of the biped walking system. The processor is configured to perform the following steps. The steps include determining 
which leg or legs are in contact with the ground, using information from the at least one accelerometer and obtaining 
an attitude of the leg, using information from the angular sensors. The steps further include obtaining a location of the 
center of gravity of the whole body including the leg, and obtaining the vertical component of acceleration of the center 
of gravity of the whole body including the leg, using information from the at least one accelerometer, The steps further 

45 include obtaining the vertical component of a ground reaction force acting on the leg, based on which leg or legs are 
in contact with the ground, the attitude of the leg, the location of the center of gravity of the whole body and the vertical 
component of acceleration of the center of gravity of the whole body. The steps further include obtaining a point of 
application of the ground reaction force, using the attitude of the leg and the location of the center of gravity of the 
whole body. The steps further include obtaining the moments acting around the joints of the leg, using the vertical 

50 component of the ground reaction force acting on the leg at the point of application of the ground reaction force, the 
vertical components of forces acting on the joints of the leg and a term of the acceleration of gravity and without using 
the horizontal components of the forces acting on the joints of the leg and a term of acceleration except the term of 
the acceleration of gravity. 

[0042] A processor for moments acting around joints of a leg of a biped walking system, according to the present 
55 invention, is operable in association with angular sensors on the joints, at least one accelerometer set on the body of 
the biped walking system and at least one sensor set on the leg. The processor is configured to perform the following 
steps. The steps include determining which leg or legs are in contact with the ground, using information from the at 
least one sensor set on the leg and obtaining an attitude of the leg, using information from the angular sensors. The 
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steps further include obtaining a location of the center of gravity of the whole body including the leg, and obtaining the 
vertical component of acceleration of the center of gravity of the whole body including the leg, using information from 
the at least one accelerometer. The steps further include obtaining the vertical component of a ground reaction force 
acting on the leg, based on which leg or legs are in contact with the ground, the attitude of the leg, the location of the 

5 center of gravity of the whole body and the vertical component of acceleration of the center of gravity of the whole 
body. The steps further include obtaining a point of application of the ground reaction force, using the attitude of the 
leg and the location of the center of gravity of the whole body. The steps further include obtaining the moments acting 
around the joints of the leg, using the vertical component of the ground reaction force acting on the leg at the point of 
application of the ground reaction force, the vertical components of forces acting on the joints of the leg and a term of 

10 the acceleration of gravity and without using the horizontal components of the forces acting on the joints of the leg and 
a term of acceleration except the term of the acceleration of gravity. 

[0043] Thus, in the present invention, the vertical components alone of forces acting on the legs are used and the 
horizontal components are not used. Accordingly, errors in measurement of forces in the horizontal direction, that is, 
accelerations in the horizontal direction do not cause errors in joint moments. Further, since the present invention does 

15 not need an acceleration of each portion of the leg, an operation speed is increased. Accordingly, real-time operations 
can be easily achieved in obtaining moments acting around joints of the legs of the biped walking system. 
[0044] Further, in the invention in which information from the at least one accelerometer is used to determine which 
leg or legs are in contact with the ground, complicated processes for the determination are not required and therefore 
an operation speed is further increased. Accordingly, real-time operations can be still easily achieved in control of 

20 human assist systems for assisting human operations and the like. 

[0045] In the invention in which information from the at least one sensor set on the leg is used to determine which 
leg or legs are in contact with the ground, operations for the determination are not required and therefore real-time 
operations can be still easily achieved in control of human assist systems for assisting human operations and the like. 
Further, the determination is made with reliability based on the sensor. 

25 

DESCRIPTION OF THE DRAWINGS 



[0046] 



30 Figure 1 illustrates a basic idea of a method of estimating a ground reaction force, according to the present inven- 

tion. Figure 2 shows in schematic form a person as a biped walking system and devices equipped with the person, 
Figure 3 illustrates functions of a processor included in the devices. Figure 4 shows a rigid body linked segment 
model used in operations of the processor shown in Figure 3. Figure 5 illustrates operations performed by a joint 
moment estimating module in the processor, shown in Figure 3. Figure 6 shows a temporal change in an estimated 

35 value of moment acting on the hip joint while the person (1 ) is going up stairs, obtained thorough an embodiment 

of the present invention. Figure 7 shows a temporal change in an estimated value of moment acting on the knee 
joint while the person (1) is going up stairs, obtained thorough an embodiment of the present invention. Figure 8 
shows a temporal change in an estimated value of moment acting on the hip joint while the person (1) is going 
down stairs, obtained thorough an embodiment of the present invention. Figure 9 shows a temporal change in an 

40 estimated value of moment acting on the knee joint while the person (1 ) is going down stairs, obtained thorough 

an embodiment of the present invention. Figure 10 shows a temporal change in an estimated value of moment 
acting on the hip joint while the person (1) is sitting in a chair, obtained thorough an embodiment of the present 
invention. Figure 11 shows a temporal change in an estimated value of moment acting on the knee joint while the 
person (1) is sitting in a chair, obtained thorough an embodiment of the present invention. Figure 12 shows a 

45 temporal change in an estimated value of moment acting on the hip joint while the person (1 ) is rising from a chair 

obtained thorough an embodiment of the present invention. Figure 13 shows a temporal change in an estimated 
value of moment acting on the knee joint while the person (1 ) is rising from a chair, obtained thorough an embod- 
iment of the present invention. Figure 14 is a flowchart showing operations of an embodiment of the present in- 
vention. 



50 



DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 



[00471 One embodiment of the present invention will be described referring to Figs 1 to 5. 

[0048] In this embodiment a method for obtaining torques to be applied to joints and a method for estimating join 
55 moments, are applied to a person as a biped walking system. 

[0049] As illustrated in Fig. 2, a person (1 ) has a pair of legs (2, 2), a torso (5) comprising a hip (3) and a chest (4), 
a head (6) and a pair of arms (7, 7). In the torso (5) the hip (3) is connected with each of the legs (2, 2) through each 
of a pair of hip joints (8, 8) and is supported on the both legs (2, 2). The chest (4) is located over the hip (3) and can 
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be declined toward the front of the person (1). The arms (7, 7) extend from the lateral sides of the upper portion of the 
chest (4), over which the head (6) is supported. 

[0050] Each of the legs (2, 2) has a thigh (9) extending from one of the hip joints (8) and a shin (11 ) extending from 
the end of the thigh via a knee joint (10). The end of the shin (11) is connected with afoot (13) via an ankle (ankle joint) 
5 (12). 

[0051] In this embodiment the person (1) is equipped with devices mentioned below in order to estimate a ground 
reaction force acting on each (2) of the legs of the person (1 ) and moments acting on each (1 0) of the knee joints and 
each (8) of the hip joints. 

[0052] The chest (4) of the torso (5) is equipped with a gyroscopic sensor (14) (hereinafter referred to as a chest 
10 gyroscopic sensor (14)), an accelerometer (15) (hereinafter referred to as a chest horizontal accelerometer (15)), a 
processor (16) and a battery (17). The chest gyroscopic sensor (14) generates an output corresponding to an angular 
velocity caused by inclination of the chest, The chest horizontal accelerometer (1 5) generates an output corresponding 
to acceleration in the horizontal direction at the chest (4). The processor (16) comprises a CPU, a RAM, a ROM and 
other components. The battery (17) functions as power source for the processor (16) and other devices. In this case, 
15 the chest gyroscopic sensor (14), the chest horizontal accelerometer (1 5), the processor (1 6) and the battery (1 7) are 
accommodated in a container (18) like a shoulder bag, fixed to the chest (4) with a belt or the like not shown in the 
drawings and thus integrally fixed to the chest (4). 

[0053] In more detail, output of the chest horizontal accelerometer (15) is acceleration in the anteroposterior direction 
in the horizontal cross section of the chest (4) (orthogonal to the axis of the chest (4)). So, when the person (1) stands 
20 In an upright posture on the level ground, the acceleration is that in the horizontal direction (the direction of the x-axis 

of the absolute coordinate system shown in Fig. 2). However, when the chest (4) is inclined from the vertical direction 
(the direction of the z-axis of the absolute coordinate system shown in Fig. 2), the acceleration is that in the direction 
inclined by the angle by which the chest (4) is inclined from the vertical direction. 

[0054] Further, the hip (3) of the torso (5) Is equipped with a gyroscopic sensor (1 9) (hereinafter referred to as a hip 
25 gyroscopic sensor (1 9)), an accelerometer (20) for generating an output corresponding to acceleration in the horizontal 
direction at the hip (3) (hereinafter referred to as a hip horizontal accelerometer (20)) and another accelerometer (21) 
for generating an output corresponding to acceleration in the vertical direction at the hip (3) (hereinafter referred to as 
a hip vertical accelerometer (21)). The hip gyroscopic sensor (19) generates an output corresponding to an angular 
velocity caused by inclination of the hip. The above sensors are integrally fixed to the hip (3) with fixing means such 
30 as a belt or the like not shown in the drawings. 

[0055] In more detail, as in the case of the chest horizontal accelerometer (1 5), the hip horizontal accelerometer (20) 
detects acceleration in the anteroposterior direction In the horizontal cross section of the hip (3) (orthogonal to the axis 
of the hip (3)). Further, in more detail, the hip vertical accelerometer (21) detects acceleration in the direction of the 
axis of the hip (3) (, which is orthogonal to the direction of acceleration detected by the hip horizontal accelerometer 
35 (20)). The hip horizontal accelerometer (20) and the hip vertical accelerometer (21) may be an integral biaxial accel- 
erometer. 

[0056] The hip joint (8) and knee joint (1 0) of each (2) of the legs are equipped respectively with a hip joint angular 
sensor (22) generating an output corresponding to a bending angle AG c and a knee joint angular sensor (23) generating 
an output corresponding to a bending angle AG d. Although Fig. 2 shows the hip joint angular sensor (22) concerning 

40 the hip joint (8) of the leg (2) on the right side of the person (1 ), alone, the hip joint (8) of the leg (2) on the left side of 
the person (1 ) is equipped with another hip joint angular sensor (22) just as in the case of the right side. 
[0057] The angular sensors (22, 23) comprise potentiometers, for example, and are attached to each (2) of the legs 
by such means as a band not shown in the drawing. In more detail, a bending angle AG c detected by each (22) of the 
hip joint angular sensors is a rotation angle around the hip joint (8) (around the lateral axis of the hip joint (8)) of the 

45 thigh (9) of each of the legs with respect to the hip (3). The reference angle is the rotation angle measured when the 
hip (3) is in proper relation with each (2) of the legs. For example, the reference angle is the rotation angle measured 
when the axis of the hip (3) and the axis of the thigh (9) are substantially parallel to each other as in the case that the 
person (1) is in an upright posture. Similarly, a bending angle AG .. detected by each (23) of the knee joint angular 
sensors is a rotation angle around the knee joint (1 0) (around the lateral axis of the hip knee joint (1 0)) of the shin (1 1 ) 

50 of each of the legs with respect to the thigh (9). The reference angle is the rotation angle measured when the thigh (9) 
is in proper relation with the shin (11). For example, the reference angle is the rotation angle measured when the axis 
of the thigh (9) and the axis of the shin (11) are substantially parallel to each other. 

[0058] One or more foot switches (24) may be provided with portions of the legs, to be in contact with the ground. 
Foot switches (24) detect which leg or legs are in contact with the ground, with a contact method. 
55 [0059] Alternatively, range sensors with an infrared method or the like, not shown in the drawings may be attached 
to the ankle joints or the knee joints. In this case, distances to the floor have been previously measured in an upright 
posture. Based on the previously measured distances and distances measured by the sensors in walking, it is deter- 
mined which leg or legs are in contact with the ground. 
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[0060] The sensors (14, 15 and 19 to 24) and the range sensors not shown in the drawings, are connected with the 
processor (1 6) via signal lines not shown in the drawings to deliver their outputs to the processor (16). 
[0061] The processor (1 6) is provided with functional modules as shown in Fig, 3. The processor (1 6) may be provided 
with a leg-motion determining module (25). The leg-motion determining module (25) determines whether the legs (2, 

5 2) of the person (1) are in a single-support phase (as shown in Fig. 1(a)) or in a double-support phase (as shown in 
Fig. 1 (b)), using data detected by the hip vertical accelerometer (21) and predetermined thresholds. Alternatively, foot 
switches (24) on portions to be in contact with the ground or range sensors not shown in the drawings, may be provided 
so that Information from the foot switches (24) or the range sensors can be used to determine which leg or legs are in 
contact with the ground. Further, the processor (16) is provided with a chest inclining angle-measuring module (26) 

10 and a hip inclining angle-measuring module (27). The chest inclining angle-measuring module (26) measures an in- 
clining angle 9 a of the chest (4) (more specifically, for example, an inclining angle 6 a from the vertical direction as 
shown in Fig. 2) in the absolute coordinate system Cf, using data detected by the chest horizontal accelerometer (15) 
and chest gyroscopic sensor (14). The hip inclining angle-measuring module (27) measures an inclining angle G b of 
the hip (3) (more specifically, for example, an inclining angle 9 b from the vertical direction as shown In Fig. 2) in the 

15 absolute coordinate system Cf, using data detected by the hip horizontal accelerometer (20) and hip gyroscopic sensor 
(19). 

[0062] Further, the processor (1 6) is provided with a reference-acceleration measuring module (28). The reference 
acceleration measuring module (28) obtains the vertical component a^z of (translational) acceleration of the origin 
point O in the body coordinate system Cp (xz coordinates in Fig. 2), using data detected by the hip horizontal accel- 

20 erometer (20) and the hip vertical accelerometer (21) and an inclining angle 9 b of the hip (3) detected by the hip 
inclining angle-measuring module (27). The body coordinate system Cp (xz coordinates in Fig. 2) is fixed to the hip 
(3) as the reference point of the person (1) In this embodiment, as shown in Fig. 2. In more detail, the body coordinate 
system Cp has its origin point 0 at the middle point of the line segment connecting the centers of the right and left hip 
joints (8, 8) of the person (1), its z axis in the vertical direction and its x axis in the moving direction of the person (1) 

25 in the horizontal plane. The directions of the three axes of the body coordinate system Cp are identical with those of 
the absolute coordinate system Cf. 

[0063] The processor (1 6) is provided with a leg-attitude computing module (32). The module (32) obtains an inclining 
angle 9 c of the thigh (9) of each (2) of the legs and an inclining angle 9 d of the shin (1 1 ) of each (2) of the legs in the 
absolute coordinate system Cf. IVIore specifically, for example, the inclining angles are those from the vertical direction, 
30 as shown in Fig. 2. The module (32) obtains the inclining angles, using data detected by the hip joint angular sensor 
(22) and knee joint angular sensor (23) of each of the legs and an inclining angle 9 b of the hip (3) measure by the hip 
inclining angle-measuring module (27). 

[0064] The processor (16) is provided with a portion center of gravity location computing module (31). The module 
(31) obtains locations of the centers of gravity of portions of the person (1 ) corresponding to rigid segments of a rigid 

35 body linked segment model mentioned below (in more detail which leg or legs, locations of the centers of gravity of 
portions corresponding to rigid segments, in the body coordinate system Cp mentioned above) . The module (31 ) obtains 
the locations of the centers of gravity, using an inclining angle 9 a of the chest (4) measured by the chest inclining 
angle-measuring module (26), an inclining angle 9 b of the hip (3) measured by the hip inclining angle-measuring 
module (27) and an inclining angle 9 c of the thigh (9) of each (2) of the legs and an inclining angle 9 d of the shin (11) 

40 of each (2) of the legs, obtained by the leg-attitude computing module (32). 

[0065] The portion center of gravity location computing module (31 ) and leg-attitude computing module (32) constitute 
a body geometric model (30). 

[0066] Further, the processor (16) is provided with a body center of gravity location computing module (41) and a 

body center of gravity-acceleration computing module (42). The module (41 ) obtains the center of gravity of the whole 
45 person (1 ) In the body coordinate system Cp, using locations of the centers of gravity of portions corresponding to rigid 
segments. The center of gravity-acceleration computing module (42) obtains vertical component az of acceleration of 
the body center of gravity GO in the body coordinate system Cp (shown in Fig. 1). 

[0067] The body center of gravity location computing module (41 ) and center of gravity-acceleration computing mod- 
ule (42) constitute a body mass distribution model (40). 

50 [0068] The processor (16) Is provided with a module (50) for estimating a point of application of ground reaction 
force. The module (50) locates a point of application of ground reaction force acting on a leg in contact with the ground, 
The module (50) locates the point, using an inclining angle 9 c of the thigh (9) and an inclining angle 9 d of the shin 
(11) obtained by the leg-attitude computing module (32) and the center of gravity of the whole obtained by the body 
center of gravity location computing module (41), Alternatively, information from foot switches (24) or range sensors 

55 not shown in the drawings can be used to estimate a point of application of ground reaction force, as mentioned in 
more detail below. 

[0069] The processor (16) is provided with a ground reaction -force estimating module (60) for obtaining a ground 
reaction force acting on each (2) of the legs. The ground reaction-force estimating module (60) obtains a location of 
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the ankle (1 2) of each (2) of the legs, as a specific part of each (2) of the legs, with respect to the center of gravity of 
the whole body GO (hereinafter referred to as body center of gravity GO). In more detail, the location is represented by 
(A Xf, A Zf) or (A Xr, A Zr) in Equation (5). The module (60) obtains the location, using a location of the body center of 
gravity GO, obtained by the body center of gravity location computing module (41 ) and inclining angles G c of the thigh 

5 (9) and G d of the shin (11) of each (2) of the legs, obtained by the leg-attitude computing module (32). Further, the 
module (60) obtains an estimated value of the vertical component of the ground reaction force acting on each (2) of 
the legs, using the location, the vertical component az of acceleration of the body center of gravity and state of which 
leg or legs are in contact with the ground, determined by the leg-motion determining module (25). The vertical com- 
ponent az is obtained by the center of gravity- acceleration computing module (42). 

10 [0070] The processor (1 6) is provided with a joint moment estimating module (71 ) for estimating moments acting on 
the l<nee joint (10) and the hip joint (8) of each of the legs. The module (71 ) estimates moments, using a value estimated 
by the ground reaction-force estimating module (60), a location estimated by the module (50) for estimating a point of 
application of ground reaction force and inclining angles G c andQ d of the thigh (9) and the shin (11) of each (2) of the 
legs, obtained by the leg-attitude computing module (32). 

15 [0071] The processor (16) is provided with a gravity compensation torque-computing module (72) for obtaining assist 
torque for assisting the person, that is, gravity compensation torques by multiplying estimated values of moments 
obtained by the joint moment estimating module (71 ), by certain factors. 

[0072] The joint moment estimating module (71 ) and gravity compensation torque-computing module (72) constitute 
a gravity compensation model (70). Operations of this embodiment carried out by the modules of the processor (16) 

20 will be described in detail below. 

[0073] In this embodiment the processor (1 6) starts to carry out the following successive operations periodically to 
obtain an estimated value of the ground reaction force acting on each (2) of the legs or the like, when the person (1) 
with his or her legs (2, 2) being in contact with the ground, turns on the power switch of the processor (1 6) not shown 
in the drawings, before he or she starts moving his or her legs, for example walking. 

25 [0074] First, the processor (1 6) has the leg-motion determining module (25) carry out processes. In the processes 
of the leg-motion determining module (25), an acceleration value at the hip (3) in the upward and vertical direction, 
detected by the hip vertical accelerometer (21), is compared with a predetermined threshold periodically. When the 
detected acceleration value exceeds the threshold, it is determined that the motion is in a single-support phase in 
which the front leg is in contact with the ground as shown in Fig. 1(a). When the detected acceleration value is less 

30 than or equal to the threshold, it is determined that the motion is in a double-support phase as shown in Fig. 1 (b). 

[0075] Alternatively, outputs of the foot switches (24) provided on portions of the legs to be in contact with the ground 
or the range sensors not shown in the drawings, are read periodically to determine which leg or legs are in contact 
with the ground. 

[0076] Concurrently with the above-mentioned processes of the foot switches (24) or the range sensors, or of the 
35 leg-motion determining module (25), the processor (16) carries out processes of the chest inclining angle-measuring 
module (26) and hip inclining angle-measuring module (27). In the processes of the chest inclining angle-measuring 
module (26), an inclining angle G a of the chest (4) in the absolute coordinate system Cf is successively obtained by 
processing data of acceleration in the horizontal direction detected by the chest horizontal accelerometer (1 5) and data 
of angular velocity detected by the chest gyroscopic sensor (14), with a known method using Karman filter. Similarly, 
40 in the processes of the hip inclining angle-measuring module (27), an inclining angle G b of the hip (3) in the absolute 
coordinate system Cf is successively obtained by processing data of acceleration in the horizontal direction detected 
by the hip horizontal accelerometer (20) and data of angular velocity detected by the hip gyroscopic sensor (19), with 
a known method using Karman filter. In this embodiment, for example, an inclining angle G a of the chest (4) and an 
inclining angle G b of the hip (3) in the absolute coordinate system Cf, are those from the vertical direction (the direction 
45 of gravity). 

[0077] An inclining angle of the chest (4) and an inclining angle of the hip (3) can also be obtained by integrating 
data of angular velocities detected by gyroscopic sensors (14) and (19), for example. However, the method using 
Kamnan filter in this embodiment enables more accurate measurements of an inclining angle G a of the chest (4) and 
an inclining angle G b of the hip (3). 
50 [0078] Next the processor (16) carries out processes of the leg-attitude computing module (32) and reference-ac- 
celeration measuring module (28), 

[0079] In the processes of the leg-attitude computing module (32), an Inclining angle G c of the thigh (9) of each (2) 
of the legs and an inclining angle G d of the shin (11) of each (2) of the legs in the absolute coordinate system Cf, are 
periodically obtained as below. Inclining angles are those from the vertical direction as shown in Fig, 2. An inclining 
55 angle G c of the thigh (9) of each (2) of the legs, is obtained by substituting a current value of bending angle AG c of 
the hip joint (8) detected by the hip joint angular sensor (22) and a current value of inclining angle Q b of the hip (3), 
obtained by the hip inclining angle-measuring module (27), into the following equation. 
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ec = Gb + AGc (6) 

[0080] A value of inclining angle G b of the hip (3) becomes negative when the hip (3) is inclined from the vertical 
5 direction in such away as the top end of the hip (3) is located forward than the bottom end, toward the front of the 
person (1). A value of bending angle AG c becomes positive when the thigh (9) is inclined In such away as the bottom 
end of the thigh (9) is located toward the front of the person (1 ). 

[0081] An inclining angle G d of the shin (11) of each (2) of the legs is obtained by substituting a current value of 
inclining angle G c of the thigh (9) previously obtained as mentioned above and a current value of bending angle AG d 
10 detected by knee joint angular sensor (23) attached to the leg, into the following equation. 

.@. @. @. @. @. @. @. @Gd = Gciil AGd (7) 

15 [0082] A value of bending angle at the knee joint (1 0) becomes positive when the shin (11) is inclined from the axis 

of the thigh (9) toward the back. 

[0083] In the processes of the refe re nee- acceleration measuring module (28), the vertical component QqZ of accel- 
eration of the origin point O in the body coordinate system Cp is obtained as below. A current value of acceleration in 
the vertical direction (the direction of the axis of the hip) at the hip (3) detected by the hip vertical accelerometer (21) 
20 is represented as aq . Then, a value of the vertical component agZ of acceleration in the body coordinate system Cp is 
obtained by substituting the value aq and a current value of inclining angle G b of the hip (3) obtained by the hip inclining 
angle-measuring module (27), into the following Equation (8). 



25 



a 0 z = aq • cos Gb u\ g (8) 



[0084] Next the processor (1 6) carries out processes of the portion center of gravity location computing module (31 ) 
to obtain locations of the centers of gravity in the body coordinate system Cp, of portions of the person (1 ) corresponding 
to rigid segments, using a rigid body linked segment model mentioned below. 

^0 [0085] As shown in Fig. 4, a rigid body linked segment model R used in this embodiment represents the person (1) 
as a combination of rigid bodies (R1, R1) corresponding to the thighs (9, 9) of the legs, rigid bodies (R2, R2) corre- 
sponding to the shins (1 1 , 1 1 ) of the legs, a rigid body R3 corresponding to the hip(3) and a rigid body R4 corresponding 
to a portion (38) comprising the chest (4), the arms (7, 7) and the head (6). The portion is hereinafter referred to as 
the upper part (38). A coupler between R1 and R3 and that between R1 and R2 correspond respectively to one (8) of 

^5 the hip joints and one (1 0) of the knee joints. By a portion corresponding to a coupler between R3 and R4, the hip (3) 
supports the chest (4) inclinably. 

[0086] In this embodiment locations of the centers of gravity G1 , G2, G3 and G4 of the portions (the thighs (9, 9) 
and the shins (1 1 , 1 1 ) of the legs, the hip (3) and the upper part (38)) corresponding to rigid segments R1 to R4 in the 
rigid body linked segment model R, are previously obtained and stored in a memory connected to the processor (16), 

^0 not shown in the drawings. 

[0087] Locations of the centers of gravity 61 , G2, G3 and G4 of the portions, stored in the processor (16), are those 
in a coordinate system fixed to each of the portions. In this case, a distance from the center of the joint at an end of a 
portion measured in the axial direction, is used to represent each of the locations of the centers of gravity G1 , G2, G3 
and G4 of the portions. For example, as shown in Fig. 4, a location of the center of gravity of one (9) of the thigh is 
represented by a distance t1 from the center of the hip joint (8) of the thigh (9) in the axial direction of the thigh (9). A 
location of the center of gravity of one (1 1 ) of the shin is represented by a distance t2 from the center of the knee joint 
(10) of the shin (11) in the axial direction of the shin (11). Values of distance t1 and distance t2 are previously stored 
in the processor (1 6). Locations of the centers of gravity G3 and G4 of the other portions are represented similarly. 
[0088] Strictly speaking, motions of the arms (7, 7) affect a location of the center of gravity G4 of the upper part (38), 

^0 However, in walking locations of the arms (7, 7) are generally symmetric with respect to the axis of the chest (4) and 
therefore a location of the center of gravity G4 of the upper part (38) does not change significantly, remaining substan- 
tially identical with that in an upright posture, for example. 

[0089] Further, in this embodiment other data of the portions (the thighs (9, 9) and the shins (11 , 11) of the legs, the 
hip (3) and the upper part (38)), including weights and sizes (for example, lengths) besides locations of the centers of 
55 gravity G1 , G2, G3 and G4, are previously obtained and stored in the processor (1 6). 

[0090] A weight of one (11 ) of the shins includes that of corresponding one (1 3) of the feet. Data stored previously 
in the processor (16) may be obtained through actual measurements, or may be estimated through a height and a 
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weight of the person (1) based on average values obtained from statistical data of persons. Generally, locations of the 
centers of gravity G1 , G2, G3 and G4, weights and sizes of the portions show a correlation with heights and weights 
of persons. Accordingly locations of the centers of gravity G1 , G2, G3 and G4, weights and sizes of the portions can 
be estinnated based on data of a height and a weight of a person with a relatively high accuracy. 

5 [0091] The portion center of gravity location connputing module (31) obtains locations of the centers of gravity G1 , 
G2, G3 and G4 of the portions corresponding to rigid segments in the body coordinate system Op (xz coordinates in 
Fig. 2) fixed to the hip (3) and having the origin point O, from the following data. The data include those previously 
stored in the processor (1 6) as mentioned above, current values of an inclining angle 0 a of the chest (4) and an inclining 
angleG b of the hip (3) and current values of an inclining angle fi c of thethigh (9) of each (2) of the legs and an inclining 

10 angle G d of the shin (1 1 ) of each (2) of the legs. An inclining angle 0 a of the chest (4) (an inclining angle of the upper 
part (38)) and an inclining angle G b of the hip (3) are obtained respectively by the chest inclining angle-measuring 
module (26) and hip inclining angle-measuring module (27), An inclining angle 9 c of the thigh (9) and an inclining 
angle 0 d of the shin (11) are obtained by the leg-attitude computing module (32), 

[0092] Since inclining angles G a to 0 d of each of the portions corresponding to rigid segments (the thigh (9) and 
15 the shin (11) of each (2) of the legs, the hip (3), and the upper part (38)) are obtained as mentioned above, locations 

and attitudes of the portions corresponding to rigid segments can be determined in the body coordinate system Cp. 
Accordingly, locations of the centers of gravity G1 , G2, G3 and G4 of the portions corresponding to rigid segments can 
be obtained. 

[0093] IVIore specifically, for example, in Fig. 4 an inclining angle (from the z axis direction) of the thigh (9) of the leg 

20 (2) on the left side is 0 c. In Fig. 4, 6 c is less than zero. Accordingly, coordinates of the location of the center of gravity 
G1 of the thigh (9) in the body coordinate system Cp are (t 1» sin 0c, ii®! • cos 9c). Further, an inclining angle of the 
shin (11) of the leg (2) on the left side is 0 d. In Fig. 4, 0 d is less than zero. Accordingly, provided that a length of the 
thigh (9) is Lc, coordinates of the location of the center of gravity G2 of the shin (1 1 ) in the body coordinate system Cp 
are (Lc • sin Gc + 12 • sin Gd, ul Lc • cos 9 cul t2» cos Gd). Locations of the centers of gravity of the thigh (9) and the 

25 shin (11) of the other leg (2), the hip (3) and the upper part (38) can be obtained in a similar way as mentioned above. 
[0094] After the portion center of gravity location computing module (31) has obtained locations of the centers of 
gravity G1, G2, G3 and G4 of the portions corresponding to rigid segments in the body coordinate system Cp, the 
processor (16) carries out operations of the body center of gravity location computing module (41). The body center 
of gravity location computing module (41) obtains a location (xg, zg) of the body center of gravity GO of the person (1), 

30 using location data of G1 , G2, G3 and G4 and weight data of the portions corresponding to rigid segments. 

[0095] In the body coordinate system Cp, a location of the center of gravity G3 and a weight of the hip (3) are 
represented respectively by (x3, z3) and m3. A location of the center of gravity G4 and a weight of the upper part (38) 
are represented respectively by (x4, z4) and m4. A location of the center of gravity G1 and a weight of the thigh (9) of 
the leg (2) on the left side of the person (1 ) are represented respectively by (x1 L, z1 L) and m 1 L. A location of the center 

35 of gravity G2 and a weight of the shin (1 1 ) of the leg (2) on the left side of the person (1 ) are represented respectively 
by (x2L, z2L) and m2L. A location of the center of gravity G1 and a weight of the thigh (9) of the leg (2) on the right 
side of the person (1 ) are represented respectively by (x1 R, z1 R) and ml R. A location of the center of gravity G2 and 
a weight of the shin (11) of the leg (2) on the right side of the person (1) are represented respectively by (x2 R, z2 R) 
and m2R. A weight of the person (1) is represented by M (=m1L+ m2L+ ml R+ m2R+m3+m4). Then, a location of the 

40 body center of gravity GO of the person (1 ) is obtained by the following equation (9). 

Xg =(mlL»xlL+mlR*xlR+m2L*x2L+m2R-x2R 
45 u(§^U@U@U@-Ur@3 • x3 + m 4 • x4 )/ M 

zg =(mlL*zlL + mlR*zlR+m2L*z2L+in2R-z2R 
u@u@u@u@-ii@3 • z3 + m 4 • z4)/ M 

50 

[0096] After the processor (1 6) has carried out operations of the body center of gravity location computing module 
(41), it carries out operations of the body center of gravity- acceleration computing module (42). 
[0097] In the operations of the body center of gravity-acceleration computing module (42), a value obtained by twice 
55 differentiating a location zg of the body center of gravity GO in the body coordinate system Cp, that is, the vertical 
component d^zg / dt^ of an acceleration of the body center of gravity GO with respect to the original point O of the body 
coordinate system Cp, is obtained using the following data. The data are time-series data of a location zg in the vertical 
direction of the body center of gravity GO in the body coordinate system Cp, obtained periodically by the body center 
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of gravity location computing module (41). The vertical component of acceleration az of the body center of gravity GO 
in the absolute coordinate system Cf, is obtained by obtaining a sum of the value of acceleration d^zg / dt^ and the 
vertical component BqZ of acceleration of the original point O of the body coordinate system Cp, in the absolute coor- 
dinate system Cf . The vertical component aQZ of acceleration has been obtained by the reference-acceleration meas- 
5 uring module (28). 

[0098] Then the processor (1 6) carries out operations of the ground reaction-force estimating module (60) as below. 
A location of the ankle (12) of each (2) of the legs in the body coordinate system Cp is obtained by operations similar 
to those of the body center of gravity location computing module (41 ), using the following data. The data include current 
values of an inclining angle fi c of the thigh (9) of each (2) of the legs and an inclining angle 9 d of the shin (1 1 ) of each 

10 (2) of the legs, a current value of an inclining angle 6 b of the hip (3) obtained by the hip inclining angle-measuring 
module (27) and data of sizes (lengths) of the thigh (9) and shin (11). More specifically, in Fig. 4, provided that a length 
of the shin (11) (a length from the center of the knee joint (10) to the ankle (12)) of the leg on the left side of the drawing 
is Ld, coordinates (x1 2, z12) of a location of the ankle (1 2) in the body coordinate system Cp are (Lc» sin Gc + Ld • sin 
ed,ul Lc • cos ecLil Ld • cos ed). In Fig. 4, e c and 6 d are less than zero. Data on the other leg can be obtained similarly. 

15 [0099] Then a location vector ( x 1 2 ul xg, u @z 12 ul zg) of the ankle (1 2) of each of the legs (2), that is, A Xf, A 
Zf, A Xr and A Zr in Equation (5) can be obtained, using current values of coordinates (x12, z12) of a location of the 
ankle (12) and coordinates (xg, zg) of a location of the body center of gravity GO in the body coordinate system C. 
[0100] When it is determined during a current period through the leg-motion determining module (25), foot switches 
(24) or range sensors not shown in the drawings that motion of the legs are in a single-support phase, an estimated 

20 value of the vertical component Fz of the ground reaction force acting on the leg (2) in contact with the ground, is 
obtained as below. The estimated value is obtained by substituting the following data into Equation (2). The data include 
values of a weight M of the person (1) and the acceleration of gravity g (previously stored in the processor (16)) and 
a current value of the vertical component az of acceleration of the body center of gravity GO in the absolute coordinate 
system Cf, obtained by the body center of gravity-acceleration computing module (42). 

25 [0101] In the above case, the vertical component Fz of the ground reaction force acting on the leg (2) not in contact 
with the ground (the leg without load), is zero. 

[0102] When it is determined during a current period through the leg-motion determining module (25), foot switches 
(24) or range sensors not shown in the drawings that motion of the legs are in a double-support phase, an estimated 
values of the vertical components Ffz and Frz of the ground reaction forces acting on each (2) of the legs, are obtained 

30 as below. The estimated values are obtained by substituting the following data into Equation (5). The data include 
values of a weight M of the person (1 ) and the acceleration of gravity g, a current value of the vertical component az 
of acceleration of the body center of gravity GO in the absolute coordinate system Cf , obtained by the body center of 
gravity-acceleration computing module (42) and current values of a location of the ankle (12) of the each (2) of the 
legs with respect to the body center of gravity GO. The current values of a location of the ankle (12) are represented 

35 by A Xf, A Zf, A Xr and A Zr in Equation (5). 

[0103] The processor (1 6) carries out operations of the module (50) for estimating a point of application of ground 
reaction force concurrently with the above operations of the body center of gravity location computing module (41), 
the body center of gravity-acceleration computing module (42) and the ground reaction -force estimating module (60). 
[0104] In operations of the module (50) for estimating a point of application of ground reaction force, a vector from 

40 the ankle (1 2) of each (2) of the legs to the point of application of the ground reaction force on the foot (1 3) of the leg , 
is obtained in the procedure below. The point of application of the ground reaction force is the point on which the whole 
ground reaction force acting on the portion of the foot (13), in contact with the ground, can be considered to be con- 
centrated. The above vector is a location vector of the point of application of the ground reaction force, with respect to 
the ankle (12) and is hereinafter referred to as a vector of a point of application of the ground reaction force. 

45 [0105] As shown in Fig. 2, the ankle joint at the ankle 12 is represented as 12A while the joint at the front end of the 
foot (13) (the so-called MP joint) is represented as 12B. First, the horizontal component x1 2 of coordinates of a location 
of the ankle joint (12A) is obtained. More specifically, in Fig. 4, provided that a length of the shin (11) (a length from 
the center of the knee joint (10) to the ankle (12)) of the leg on the leftside of the drawing is Ld, coordinates (x12, z12) 
of location of the ankle (12) in the body coordinate system Cp are (Lc • sin 0c + Ld • sin Gd, Ul Lc • cos GcUl Ld • cos 

50 Gd). In Fig. 4, G c and G d are less than zero. Data on the other leg can be obtained similarly. Further, provided that a 
horizontal distance between the ankle joint (12A) and the MP joint (12B) is a constant D, the horizontal component 
x12B of coordinates of a location of the MP joint (12B) is obtained through the following equation. 

55 X12B = x12+D 

[0106] Then walking mode is determined. If the vertical component of a difference between a location of the left ankle 
joint and that of the right ankle joint, as obtained in such a way as mentioned above, exceeds a certain threshold while 
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the both legs are in contact with the ground, it is determined that the person (1) is going up or down stairs or going 
uphill or downhill. Othenwise, it is determined that the person (1) is walking under normal conditions. 
[0107] Then when the person (1) is walking under normal conditions, the horizontal component of the endpoint of 
the vector of a point of application of the ground reaction force, is obtained by comparing the horizontal components 

5 obtained as mentioned above, in the following procedure. If the horizontal component xg of GO is less than the horizontal 
component x1 2 of the ankle joint 1 2A, the horizontal component of the endpoint of the vector of a point of application 
of the ground reaction force is assumed to be the horizontal component x12 of the ankle joint 12A. If the horizontal 
component xg of GO is between horizontal component x1 2 of the ankle joint 1 2A and the horizontal component x1 2B 
of the MP joint 12B, the horizontal component of the endpoint of the vector of a point of application of the ground 

10 reaction force is assumed to be the horizontal component xg of GO. If the horizontal component xg of GO is greater 
than the horizontal component x12B of the MP joint 12B, the horizontal component of the endpoint of the vector of a 
point of application of the ground reaction force is assumed to be the horizontal component x 128 of the MP joint 128, 
[0108] When the person (1) is going up or down stairs or going uphill or downhill, the horizontal component of the 
endpoint of the vector of a point of application of the ground reaction force is always assumed to be the horizontal 

15 component x12B of the MP joint (12B). 

[0109] The vertical component of the vector of a point of application of the ground reaction force, is obtained with 
the assumption that a distance between the ankle joint 12A and the ground is a constant E. 

[0110] In the above procedure, the vector of a point of application of the ground reaction force, can be obtained. The 
vector is starting at the ankle joint 12A and ending at the point of application of the ground reaction force. 

20 [0111] Alternatively the module (50) for estimating a point of application of ground reaction force, can obtain the 
vector of a point of application of the ground reaction force, using information from the foot switches (24) or range 
sensors in the following procedure. In this case, the contact-type foot switches (24) or the range sensors for the ankle 
joints (1 2A) and the MP joints (1 28) are used to determine whether or not each of the heels and each of tiptoes are in 
contact with the ground. If both foot switches (24) or both range sensors for the ankle joint (1 2A) and the M P joint (1 2B) 

25 indicate that the portions are in contact with the ground, the horizontal component of the vector of a point of application 
of the ground reaction force, is obtained in a similar procedure to that in the above case where the person (1) is walking 
under normal conditions. If the foot switch (24) or range sensor for the ankle joint (12A), alone indicates that the portion 
is in contact with the ground, the horizontal component of the endpoint of the vector of a point of application of the 
ground reaction force is assumed to be the horizontal component x12 of the location coordinates of the ankle joint 

30 (12A). If the foot switch (24) or range sensor for the MP joint (128), alone indicates that the portion is in contact with 
the ground, the horizontal component of the endpoint of the vector of a point of application of the ground reaction force 
is assumed to be the horizontal component x12B of the location coordinates of the MP joint (12B). 
[0112] The vertical component of the vector of a point of application of the ground reaction force, is obtained with 
the assumption that a distance between the ankle Joint (12A) and the ground is a constant E. 

35 [0113] In the above procedure, the vector of a point of application of the ground reaction force, can be obtained, 
using information from the foot switches (24) or range sensors. The vector is starting at the ankle joint 12A and ending 
at the point of application of the ground reaction force. 

[0114] After having estimated the location of a point of application of the ground reaction force, the processor (16) 
caries out operations of the joint moment estimating module (71) to obtain moments acting on the knee joint (10) and 

40 the hip joint (8) of each (2) of the legs. The operations are carried out based on the so-called inverse dynamics model, 
using current values of data obtained by the ground reaction-force estimating module (60), module (50) for estimating 
a point of application of ground reaction force and leg-attitude computing module (32). The inverse dynamics model 
uses equations of translational motion and rotational motion for each portion of the person (1), corresponding to rigid 
segment, to obtain moments acting on the joints of each of the legs, one after another, from moment acting on the joint 

45 next to the point of application of ground reaction force. In this embodiment, moment acting on the knee joint (1 0) of 
each of the legs, is obtained and then that acting on the hip joint (8) is obtained. 

[0115] In more detail, referring to Fig. 5, a force acting on the ankle (12) at an end of the shin (11) of each (2) of the 
legs (a joint reaction force), a force acting on the knee joint (1 0) of the shin (1 1 ) (a joint reaction force) and an translational 

acceleration of the center of gravity G2 of the shin (11) are represented by components in the absolute coordinate 
50 system Cf as below. The representations are """(F^ x, u@f•^z) , "'"(F2 x, u@F2z) , and "'"(a2X,u@a2z). A weight of the shin 
(1 1 ) is represented as m2. If acceleration terms except the term of the acceleration of gravity are neglected, the equation 
of translational motion of the center of gravity G2 of the shin (11 ) is as below. 



'^(0,0)u@l<^ixu| F2X, u^izu| F22;u| m2 • g) 
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[0116] Accordingly, as to the vertical components, the equation of motion is as below. 

F2ztJ#FvMi| ni2» S . @. @. @. @ (10) 

5 

[01 1 7] An approximate value of the vertical component F^z of the joint reaction force acting on the ankle (12) at an 
end of the shin (11) is equal to an estimated value of the vertical component of the ground reaction force obtained by 
the ground reaction-force estimating module (60) for the shin (11) of the leg (2). In more detail, in a single-support 

10 phase the vertical component F^z of the joint reaction force is the vertical component Fz of the ground reaction force 
obtained through Equation (2) when the leg is in contact with the ground. The vertical component F^z is zero when the 
leg is idle. Further in a double-support phase the vertical component F^z of the joint reaction force is the vertical 
component Frz of the ground reaction force in Equation (5) when the leg is the rear one of the person (1 ) in the traveling 
direction. The vertical component F-iZ of the joint reaction force is the vertical component Ffz of the ground reaction 

15 force in Equation (5) when the leg is the front one of the person (1) in the traveling direction. 

[0118] Accordingly, the vertical component F2Z of the joint reaction force acting on the knee joint (10) of each of the 
legs can be obtained by substituting data of the vertical component F^z of the ground reaction force obtained by the 
ground reaction -force estimating module (60), data of a weight .3 of the shin (11), previously obtained and a value of 
the acceleration of gravity g, into Equation (10). 

20 [0119] Referring to Fig. 5, a moment acting on the ankle (12) at an end of the shin (11) of each (2) of the legs, a 
moment acting on the hip joint (10) of the shin (11 ), a moment of inertia around the center of gravity G2 of the shin (11) 
and an angular acceleration around the center of gravity G2 of the shin (11), are represented as M^, M2, \q2 and 
Referring to Fig. 4, a distance between the center of gravity G2 of the shin (11) and the knee joint (1 0) and a distance 
between the center of gravity G2 of the shin (11 ) and the ankle (12) are represented respectively as tg and tg' (=Ld - 

25 tg). if horizontal force terms and angular acceleration terms are removed, the equation of rotational motion around the 
center of gravity G2 of the shin (11 ) is as below. 

Ig2' «2^Q®®MiU| M2ti| FiZ' tj'ftM ^du| F2Z* t2* sin 

30 

The equation can be rewritten as below. 

55 M 2 = M itil Fiz - t2 ' ^diil F2Z - t 2 • sin 6^d . @, @. @. @(11) 

[0120] Ml in Equation (11 ) is a moment obtained as an outer (vector) product of a vector of a point of application of 
ground reaction force, obtained by the module (50) for estimating a point of application of ground reaction force and 
40 a vector of ground reaction force, obtained by the ground reaction -force estimating module (60). Further, since angular 
acceleration terms are removed, a2 is assumed to be zero. 6 d is an inclining angle of the shin (11), obtained by the 
leg-attitude computing module (32). F^z is an estimated value of the vertical component of a ground reaction force, 
obtained by the ground reaction-force estimating module (60), as mentioned above. F2Z is obtained through Equation 
(10). 

45 [0121] Accordingly, moment M2 acting on the knee joint (1 0) is obtained by substituting the following data into Equa- 
tion (11). The data includes an estimated value of the vertical component of a ground reaction force, obtained by the 
ground reaction -force estimating module (60) and a vector of a point of application of ground reaction force, obtained 
by the module (50) for estimating a point of application of ground reaction force an inclining angle of the shin (11). The 
data further includes an inclining angle 0 d of the shin (11), obtained by the leg-attitude computing module (32), the 

50 vertical component F2Z of a joint reaction force, obtained through Equation (1 0), a size (d) of the shin (11) and a location 
(t2) of the center of gravity G2. 

[0122] The joint moment estimating module (71) obtains moment Mg acting on the knee joint (10) of the shin (11) as 
mentioned above. Then the module obtains a moment acting on the hip joint (8) of the thigh (9) in a way similar to that 
mentioned above. The basic idea of the operation is identical with that for obtaining moment IVI2 acting on the knee 
55 joint (10) and therefore detailed explanation with a drawing is not given. The outline of the operation is as below, 

[0123] First, the vertical component F3Z of the joint reaction force acting on the knee joint (8) of the thigh (9) is 
obtained through Equation (12) (which has the form identical with that of Equation (1 0)) on translational motion of the 
center of gravity G1 (Fig. 4) of the thigh (9). 
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10 



F3Z = Fgzul • g (12) 

[0124] F2Z is the vertical component of the joint reaction force on the l<nee joint (1 0), previously obtained through 
Equation (1 0). m-i is a weight of the thigh (9) previously obtained and g is the acceleration of gravity. 
[0125] Then, moment M3 acting on the hip joint (8) of the thigh (9) is obtained through Equation (13) (which has the 
form identical with that of Equation (11)) on rotational motion of the center of gravity G1 of the thigh (9). 



M 3 = M F2Z« 1 1 ' 6cii\ F^z* ti • sin ec (13) 



[0126] M2 is a moment on the knee joint (10), obtained through Equation (11). FgZ is the vertical component of the 
joint reaction force on the knee joint (10), obtained through Equation (10). F3Z is the vertical component of the joint 
reaction force on the hip joint (8), obtained through Equation (1 2). 0 c is an inclining angle of the thigh (9) obtained by 
the leg-attitude computing module (32). t^ is a distance from the center of the hip joint (8) to the center of gravity G1 
of the thigh (9), as shown in Fig. 4, while t^' is a distance from the center of the knee joint (10) to the center of gravity 
G1 of the thigh (9), as shown as Lc - 1^ in Fig. 4. These values t^ and t^' are determined based on a location of the 
center of gravity G1 and a size (length) of the thigh (9), previously obtained. 

[0127] Then, a gravity compensation torque computing module (72) computes a gravity compensation torques by 
multiplying values of knee joint moments and hip joint moments, obtained by the joint moment estimating module (71), 
by certain factors. The factors are given as constants refereed to as assist ratios. In human assist systems comprising 
electric motors or the like for supplying knee joints (10) and hip joints (8) with assist torques, to assist operations of 
25 the person (1), assist ratios are determine to compensate certain ratios of joint moments. Gravity compensation torques 
obtained as mentioned above, are used for control of human assist systems. 

[0128] The operations mentioned above are successively carried out periodically to successively estimate, in real 
time, ground reaction force acting on each (2) of the legs, moments acting on the knee joint (10) and hip joint (8) of 
each (2) of the legs and gravity compensation torques on the knee joint (1 0) and hip joint (8). 
[0129] The above-mentioned operations of an embodiment of the present invention are summarized in Fig. 14. At 
step SI 410 the leg-motion determining module (25) determines which leg or legs are in contact with the ground, In 
place of the leg-motion determining module (25), foot switches (24) or range sensors may be used forthe detemiination. 
At step S1420, the leg-attitude computing module (32) obtains attitudes of the legs. At step S1430, the body center of 
gravity location computing module (41) obtains the center of gravity of the body. At step SI 440, the center of gravity- 

^5 acceleration computing module (42) obtains an acceleration of the body center of gravity. At step S 1450, the ground 
reaction -force estimating module (60) obtains the vertical component of a ground reaction force. At step SI 460, the 
module (50) for estimating a point of application of ground reaction force, obtains a point of application of ground 
reaction force. At step 8 1470, the joint moment estimating module (71) obtains moments acting on the joints. At step 
SI 480, gravity compensation torque-computing module (72) obtains torque to be applied to the joints. Temporal chang- 

^0 es in estimated values of moments acting on the joints, obtained by the above-mentioned operations of the processor 
(16), are shown withd: in Figs. 6 to 13. In Figs. 6 to 13, .. shows estimated values of moments acting on the joints, 
obtained through steps in which operations are performed using temns of accelerations and terms of horizontal forces, 
with subsequent filtering. In Figs. 6 to 13, ?. shows estimated values of moments acting on the joints, obtained through 
steps in which operations include terms of accelerations and terms of horizontal forces, without subsequent filtering. 
Fig. 6 shows moments acting on the hip joint while the person (1 ) is going up stairs. Fig. 7 shows moments acting on 
the knee joint while the person (1) is going up stairs. Fig. 8 shows moments acting on the hip joint while the person 
(1 ) is going down stairs. Fig. 9 shows moments acting on the knee joint while the person (1 ) is going down stairs. Fig. 
10 shows moments acting on the hip joint while the person (1) is sitting in a chair. Fig. 11 shows moments acting on 
the knee joint while the person (1 ) is sitting in a chair. Fig. 12 shows moments acting on the hip joint while the person 

5^ (1 ) is rising from a chair. Fig. 1 3 shows moments acting on the knee joint while the person (1 ) is rising from a chair 
[0130] In the steps of the present invention for obtaining moments acting on the joints, operations are performed 
without using terms of accelerations and terms of horizontal forces. However, referring to Figs. 6 to 13, changes in 
estimated values of moments on the joints according to the present invention, are similar to those obtained through a 
method in which operations are performed using terms of accelerations and terms of horizontal forces. In particular 

55 changes in estimated values during periods while the person (1 ) is sitting in a chair and the person (1) is rising from a 
chair, are very similar to those obtained through a method in which operations are performed using terms of acceler- 
ations and terms of horizontal forces. 
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[0131] As mentioned above, the embodiment allows real-time and easy estimation of ground reaction force acting 
on each (2) of the legs and moments acting on the hip joint (8) and the knee joint (10) of each (2) of the legs, using 
relatively small and light sensors and without setting to the legs (2) such sensors as hinder the person (1 ) from walking 
or make load of motion heavy. The relatively small and light sensors include the angular sensors (22, 23) set on the 

5 hip joints (8) and the knee joints (10) and the gyroscopic sensors (14, 19) and accelerometers (15, 20, 21). Further, in 
the steps for obtaining moments acting on the Joints, operations are performed without using terms of accelerations 
and terms of horizontal forces. Accordingly, noises caused by operations of terms of accelerations can be eliminated 
and real-time operations can be easily achieved in the absence of operations of terms of accelerations. In particular, 
accurate estimation can be carried out while the person (1) sitting in and rising from a chair. 

10 [0132] In the embodiment mentioned above, the present invention is applied to the person (1 ). The present invention 
can be applied also to biped walking robots as biped walking systems. In some biped walking robots, the hip and the 
chest are integrated. In such cases a gyroscopic sensor and a accelerometer for the horizontal direction are attached 
to either the hip or the chest alone to estimate ground reaction forces and joint moments on the legs in a similar way 
to that of the above-mentioned embodiment. Further, in biped waking robots, bending angles of the hip joints and the 

15 knee joints can be obtained through controlled variables of control devices for joint actuators. 

[0133] In the embodiment mentioned above, data detected by the hip vertical accelerometer (21) are directly used 
to determine a phase of motions of the legs (2). In place of the detected data, for example, the vertical component of 
acceleration aO of the hip (3) in the absolute coordinate system Cf, obtained by the reference-acceleration measuring 
module (28), can be used. 

20 [0134] As mentioned above, according to the present invention, joint moments acting on the legs of walking systems 

can be obtained and torques to be applied to the joints can further be obtained, in control of human assist systems 
and in control of movement of biped walking robots. Such human assist systems are intended to assist human oper- 
ations against gravity including going up and down stairs, sitting and standing up, squatting, and moving up and down 
with heavy load. 

25 

Claims 

1 . A method for obtaining torques to be applied to joints of a leg of a biped walking system, comprising the steps of: 

30 

determining which leg or legs are in contact with the ground; 
obtaining an attitude of the leg; 

obtaining the vertical component of acceleration of the center of gravity of the whole body including the leg; 
obtaining the vertical component of a ground reaction force acting on the leg, based on which leg or legs are 
35 in contact with the ground, the attitude of the leg and the vertical component of acceleration of the center of 

gravity of the whole body including the leg; 

obtaining a point of application of the ground reaction force; 

obtaining moments acting around the joints of the leg, using the vertical component of the ground reaction 
force acting on the leg at the point of application of the ground reaction force, the vertical components offerees 
40 acting on the joints of the leg and a term of the acceleration of gravity and without using the horizontal com- 

ponents of the forces acting on the joints of the leg and a temn of acceleration except theterm of the acceleration 
of gravity; and 

obtaining the torques to be applied to the joints of the leg, based on the moments acting around the joints of 
the leg. 

45 

2. A method according to claim 1 , wherein in the step of determining which leg or legs are in contact with the ground, 
the determination is made based on a value of the vertical component of acceleration measured on the body. 

3. A method according to claim 1 , wherein in the step of detemnining which leg or legs are in contact with the ground, 

50 the determination is made using a sensor. 

4. A method according to any one of claims 1 to 3, wherein in the step of obtaining a point of application of the ground 
reaction force, the point is obtained based on the attitude of the leg and a location of the center of gravity of the body. 

55 5. A method according to claim 4, wherein in the step of obtaining a point of application of the ground reaction force, 
the point is obtained further using infomnation from a sensor. 

6. A method according to any one of claims 1 to 5, wherein the vertical component of acceleration of the center of 
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gravity of the whole body, is obtained based on locations of the centers of gravity of portions of the body, obtained 
based on attitudes of the leg and other portions of the body, and the vertical connponent of acceleration measured 
at the body. 

. A method according to any one of claims 1 to 6, wherein in the step of obtaining moments acting around the joints 
of the leg, at first the vertical component of a force acting on and a moment acting around the knee joint of the 
shin, are obtained using the vertical component of the ground reaction force acting on the shin at the point of 
application of the ground reaction force and a term of the acceleration of gravity and without using the horizontal 
component of the ground reaction force and a term of acceleration except the term of the acceleration of gravity 
and then the vertical component of a force acting on and a moment acting around the hip joint of the thigh, are 
obtained using the vertical component of a force acting on and a moment acting around the knee joint of the thigh 
and a term of the acceleration of gravity without using the horizontal component of the horizontal component of 
the force acting on the knee joint and a term of acceleration except the term of the acceleration of gravity 

. A method for obtaining moments acting around joints of a leg of a biped walking system, comprising the steps of: 

determining which leg or legs are in contact with the ground; 
obtaining an attitude of the leg; 

obtaining the vertical component of a ground reaction force acting on the leg, based on which leg or legs are 
in contact with the ground, the vertical component of acceleration of the center of gravity of the whole body 

including the leg and the attitude of the leg; 

obtaining a point of application of the ground reaction force; and 

obtaining the moments acting around the joints of the leg, using the vertical component of the ground reaction 
force acting on the leg at the point of application of the ground reaction force, the vertical components offerees 
acting on the joints of the leg and a term of the acceleration of gravity and without using the horizontal com- 
ponents of the forces acting on the joints of the leg and a temn of acceleration except the term of the acceleration 
of gravity. 

. A processor for obtaining torques to be applied to Joints of a leg of a biped walking system, the processor being 
operable in association with angular sensors on the joints and at least one accelerometer set on the body of the 
biped walking system, wherein the processor is configured to perform the steps of: 

determining which leg or legs are in contact with the ground, using information from the at least one acceler- 
ometer; 

obtaining an attitude of the leg, using information from the angular sensors; 
obtaining a location of the center of gravity of the whole body including the leg; 

obtaining the vertical component of acceleration of the center of gravity of the whole body including the leg, 
using information from the at least one accelerometer; 

obtaining the vertical component of a ground reaction force acting on the leg, based on which leg or legs are 
in contact with the ground, the attitude of the leg, the location of the center of gravity of the whole body and 
the vertical component of acceleration of the center of gravity of the whole body; 

obtaining a point of application of the ground reaction force, using the attitude of the leg and the location of 
the center of gravity of the whole body; 

obtaining moments acting around the joints of the leg, using the vertical component of the ground reaction 
force acting on the leg at the point of application of the ground reaction force, the vertical components of forces 
acting on the joints of the leg and a term of the acceleration of gravity and without using the horizontal com- 
ponents of the forces acting on the joints of the leg and a term of acceleration except the term of the acceleration 
of gravity; and 

obtaining the torques to be applied to the joints of the leg, based on the moments acting around the joints of 

the leg. 

0. A processor for obtaining torques to be applied to joints of a leg of a biped walking system, the processor being 
operable in association with angular sensors on the joints, at least one accelerometer set on the body of the biped 
walking system and at least one sensor set on the leg, wherein the processor is configured to perform the steps of: 

determining which leg or legs are in contact with the ground, using information from the at least one sensor 
set on the leg; 

obtaining an attitude of the leg, using information from the angular sensors; 
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obtaining a location of tlie center of gravity of the whole body including the leg; 

obtaining the vertical connponent of acceleration of the center of gravity of the whole body including the leg, 
using information from the at least one accelerometer; 

obtaining the vertical component of a ground reaction force acting on the leg, based on which leg or legs are 
5 in contact with the ground, the attitude of the leg, the location of the center of gravity of the whole body and 

the vertical component of acceleration of the center of gravity of the whole body; 

obtaining a point of application of the ground reaction force, using the attitude of the leg and the location of 
the center of gravity of the whole body; 

obtaining moments acting around the joints of the leg, using the vertical component of the ground reaction 
10 force acting on the leg at the point of application of the ground reaction force, the vertical components offerees 

acting on the joints of the leg and a term of the acceleration of gravity and without using the horizontal com- 
ponents of the forces acting on the joints of the leg and a term of acceleration excepttheterm of the acceleration 
of gravity; and 

obtaining the torques to be applied to the joints of the leg, based on the moments acting around the joints of 
15 the leg. 

11. A processor for obtaining moments acting around joints of a leg of a biped walking system, the processor being 
operable in association with angular sensors on the joints, at least one accelerometer set on the body of the biped 
walking system, wherein the processor is configured to perform the steps of: 

20 

determining which leg or legs are in contact with the ground, using information from the at least one acceler- 
ometer; 

obtaining an attitude of the leg, using information from the angular sensors; 
obtaining a location of the center of gravity of the whole body including the leg; 
25 obtaining the vertical component of acceleration of the center of gravity of the whole body including the leg, 

using information from the at least one accelerometer; 

obtaining the vertical component of a ground reaction force acting on the leg, based on which leg or legs are 
in contact with the ground, the attitude of the leg, the location of the center of gravity of the whole body and 
the vertical component of acceleration of the center of gravity of the whole body; 
30 obtaining a point of application of the ground reaction force, using the attitude of the leg and the location of 

the center of gravity of the whole body; and 

obtaining the moments acting around the joints of the leg, using the vertical component of the ground reaction 
force acting on the leg at the point of application of the ground reaction force, the vertical components offerees 
acting on the joints of the leg and a term of the acceleration of gravity and without using the horizontal com- 
35 ponents of theforces acting on the joints of the leg and a term of acceleration excepttheterm of the acceleration 

of gravity. 

12. A processor for obtaining moments acting around joints of a leg of a biped walking system, the processor being 
operable in association with angular sensors on the joints, at least one accelerometer set on the body of the biped 

40 walking system and at least one sensor set on the leg, wherein the processor is configured to perform the steps of: 

determining which leg or legs are in contact with the ground, using information from the at least one sensor 
set on the leg; 

obtaining an attitude of the leg, using information from the angular sensors; 
45 obtaining a location of the center of gravity of the whole body including the leg; 

obtaining the vertical component of acceleration of the center of gravity of the whole body including the leg, 
using infonnation from the at least one accelerometer; 

obtaining the vertical component of a ground reaction force acting on the leg, based on which leg or legs are 

in contact with the ground, the attitude of the ieg, the location of the center of gravity of the whole body and 
50 the vertical component of acceleration of the center of gravity of the whole body; 

obtaining a point of application of the ground reaction force, using the attitude of the leg and the location of 
the center of gravity of the whole body; and 

obtaining the moments acting around the joints of the leg, using the vertical component of the ground reaction 
force acting on the leg at the point of application of the ground reaction force, the vertical components offerees 
55 acting on the joints of the leg and a term of the acceleration of gravity and without using the horizontal com- 

ponents of theforces acting on the joints of the leg and a term of acceleration excepttheterm of the acceleration 
of gravity. 
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13. A computer software program product, implementing a method according to any of claims 1 to 8 when running on 
a computing device. 
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(a) 




21 



EP 1 422 129 A2 



FIG.2 
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IG. 4 
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FIG. 5 
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START 



D 



FIG. 



WHICH LEG OR LEGS ARE IN CONTACT WITH 
THE GROUND IS DETERMINED 
(LEG-MOTION DETERMINING MODULE (25)) 



ATTITUDES OF THE LEGS ARE OBTAINED 

(LEG-ATTITUDE COMPUTING MODULE (32)) 



THE CENTER OF GRAVITY OF THE BODY IS 
OBTAINED 
(BODY CENTER OF GRAVITY LOCATION 

COMPUTING MODULE (41)) 



AN ACCELERATION OF 

THE BODY CENTER OF GRAVITY IS OBTAINED 

(CENTER OF GRAVITY ACCELERATION 

COMPUTING MODULE (42) ) 



THE VERTICAL COMPONENT OF 
A GROUND REACTION FORCE IS OBTAINED 
(GROUND REACTION-FORCE 
ESTIMATING MODULE (60)) 



A POINT OF APPLICATION OF 

GROUND REACTION FORCE IS OBTAINED 
(MODULE (50) FOR ESTIMATING A POINT OF 
APPUCATION OF GROUND REACTION FORCE) 



S1410 



,S1420 



.SI 430 



S1440 



SI 450 



SI 460 



MOMENTS ACTING ON THE JOINTS ARE OBTAINED 
(JOINT MOMENT ESTIMATING MODULE (71)) 



S1470 



TORQUE TO BE APPUED TO THE JOINTS 

ARE OBTAINED 
(GRAVITY COMPENSATION 
TORQUE-COMPUTING MODULE (72)) 



S1480 



END 
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